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INTRODUCTION  ( R) 


This  report  defines  the  reference  coordinate  frames  and  provides  the 
dynamic  equations  required  to  support  development  of  autopilot  initialization 
algorithms  in  the  fire  control  computer  for  the  Vertical  Launch  ASROC  system. 
The  report  presents  a  mathematical  definition  of  the  dynamic  data  required  by 
the  missile  autopilot  for  prelaunch  initialization.  These  include: 

(1)  Attitude  of  the  command  reference  frame  relative  to  the  autopilot 
reference  frame 

(2)  Velocity  of  the  launch  point  reference  relative  to  the  moving  air 
mass 
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NOTATION  FOR  VECTORS  AND  ORTHOGONAL  TRANSFORMATIONS 


We  understand  that  r  represents  a  vector  quantity  without  reference  to 

any  particular  coordinate  frame.  If  we  wish  to  specify  the  vector  r  expressed 

in  terms  of  x.y.z.  coordinates,  we  use  r.. 

111  i 

The  orthogonal  transformation  A_  represents  the  transformation  from  the 

x.y.z  coordinate  frame  to  the  x.y.z,  frame.  Thus: 
i  i  i  3  3  3 

x .  =  A.  .x.  ( 1 ) 

3  13  i 

The  inverse  transformation  (from  x.y.z.  to  x.y.z.)  may  be  indicated  by 
T  3  3  3  ill 

A.,  or,  equivalently.  A1,  (the  transpose  of  A. . ) .  The  vector  r  is  understood 
3i  13  13 

to  have  scalar  components  r  ,  r  ,  and  r  : 

x  y  z 

r  -  [r  r  r  ]T  (2) 

x  y  z 


while  r^  has  components: 


r .  *  [r  .  r  .  r  .  ] 
l  xi  yi  zi 
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REFERENCE  COORDINATE  FRAMES  (R) 


Figure  1.  Reference  Coordinate  Frames 


STAB  US  REFERENCE  (x0Yqz0> 

xQ  and  yQ  lie  in  the  local  horizontal  plane  with  positive  xQ  true  north 
and  positive  yQ  east  (Fig  2).  Positive  zQ  is  the  local  vertical-downward.  We 
assume  xqYqZq  is  40  inertial  reference  frame. 


Figure  2.  Stable  Reference  Frame 


SHIP  REFERENCE  (x^Z  ) 

The  ship  reference  cures  (Fig  3)  are  the  body  axes  of  the  ship  used  as  the 
reference  for  measurement  of  the  roll  ($),  pitch  (0),  and  yaw  (t|/)  angles  of 
the  ship.  These  axes  correspond,  for  example,  to  the  axes  of  the  MK  19  Gyro¬ 
compass  or  AN/WSN-5  Inertial  System.  The  axes  are  fixed  in  attitude  relative 
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to  the  ship  and  rotate  with  the  ship  relative  to  the  stable  reference 
(XgYgZg).  x1  is  the  roll  axis  of  the  ship  with  positive  forward,  y^  is  the 
pitch  axis,  positive  to  starboard,  and  is  the  yaw  axis  with  positive 
downward . 


Figure  3.  Ship  Reference  Frame 


The  attitude  of  the  ship  reference  (x^y^z^)  relative  to  the  stable 
reference  (x^y^Zg)  is  a  consequence  of  the  ordered  Euler  angle  rotations: 


(1)  i|>  about  the  z-axis  (yaw  or  heading) 

(2)  e  about  the  y-axis  (pitch) 

(3)  $  about  the  x-axis  (roll) 


The  orthogonal  transformation  from  the  stable  reference  (x  y  z  )  to  the 

0  0  0 

ship  reference  (x^^z^)  is; 


Clip  C0 

si|>  c0 

-S  0 

ci|ps6s$ 

Sl|PS0S$ 

C0s$ 

-Sl|>c$ 

+  Cl|lC$ 

C^S  0C  $ 

s^sec* 

C  0C$ 

+  S|J|S$ 

-c4is$ 

where  c  and  s  denote  the  cosine  and  sine  functions. 


The  ship  reference  frame,  as  defined  above,  corresponds  to  the  reference 
frame  conventionally  used  for  attitude  reference  in  virtually  all  modem  tech¬ 
nical  publications,  ie,  positive  roll  and  yaw  motions  are  to  starboard  and 


positive  pitch  corresponds  to  a  bow-up  attitude.  OP  1700  (Standard  Fire 
Control  Symbols)  does  not  conform  to  this  convention,  but  instead  defines 
positive  roll  motion  to  port  and  positive  pitch  as  bow-down  attitude.  This 
report  will  continue  to  use  the  conventional  definitions.  The  modifications 
required  to  use  the  OP  1700  definitions  are  presented  in  the  Appendix. 

LAUNCHER  REFERENCE  (x  y„z„ ) 

2  2  2 

The  vertical  launching  system,  when  installed,  is  nominally  aligned  with 
the  ship  reference  axes  (x^y^z^).  In  fact,  however,  these  axes  are  generally 
not  used  directly  because  of  structural  obstructions.  Instead,  the  launching 
system  is  aligned  with  respect  to  some  launcher  reference  (*2*2Z'2>  was» 

in  turn,  previously  aligned  with  respect  to  the  ship  reference  (x^y^z^.  The 
transformation  represents  the  misalignment  between  the  ship  reference 
(x^y^z^  and  the  launcher  reference  ^X2^2Z2^  i-s  3  ^unct;*-on  °f  static  and 

dynamic  alignment  errors  due  to  errors  in  initial  alignment  and  subsequent 
structural  flexure . 

AUTOPILOT  ALIGNMENT  REFERENCE  (x^  *  )  W 


Figure  4.  Autopilot  Alignment  Reference 


The  autopilot  alignment  reference  axes  (x^y.^)  (Fig  4)  represent  the 
nominal  (or  intended)  axes  of  the  autopilot,  that  is,  the  autopilot  axes  when 
the  missile,  in  its  canister  and  cell,  has  been  aligned,  without  error,  with 
respect  to  the  launcher  reference  (x  y  z  ).  x  is  the  roll  axis  of  the  auto- 

*  *  4  J 

pilot,  y  the  pitch  axis,  and  z  the  yaw  axis.  Positive  x  is  forward  in  the 

J  J  J 

missile  and  positive  y3  is  to  starboard. 


The  configuration  of  the  vertical  launch  system  is  such  that,  with  the 
missile  and  its  canister  loaded  into  one  of  the  cells,  the  positive  x3  axis  is 
in  the  direction  of  negative  and  positive  z3  is  at  an  angle  X  to  port  of 
positive  x^.  Positive  y^  completes  the  right-handed  triad. 

The  angle  x  will  generally  be  different  for  missiles  loaded  in  different 
cells,  but  will  be  a  constant  for  a  given  cell.  Thus  X  will  be  known,  when  a 
particular  cell  is  selected  for  launch. 


The  attitude  of  the  autopilot  alignment  reference  (x^y.^)  relative  to 
the  launcher  reference  ^X2Y2Z2^  :*'s  3  conse<3uence  °f  the  ordered  Euler  angle 
rotations : 


( 1 )  90  °  about  the  y  axis 


(2)  X  about  the  x  axis 


The  orthogonal  transformation  from  the  launcher  reference  (x  y  z  )  to  the 

2  2  2 

autopilot  alignment  reference  (X3Y3Z3)  is : 


23 


0 

SX 

cx 


0 

cx 

-sX 


-1 

0 

0 


(5) 


8 


AUTOPILOT  REFERENCE  (xj.zJ 

4  4  4 


The  autopilot  reference  axes  (x^y^z4)  represent  the  actual  reference  axes 

of  the  autopilot  (x^roll,  y^pitch,  z^-yaw)  with  the  missile  and  its  canister  ? 

loaded  into  a  cell.  The  transformation  M  then  represents  the  misalignment 

error  of  the  autopilot  axes  (x.y.z  )  relative  to  the  autopilot  alignment 

4  4  4 

reference  (x^y^z.^). 

COMMAND  REFERENCE  (xvz) 

5  5  5 


BALLISTIC 

VECTOR 


Figure  5.  Command  Reference 


The  command  reference  (x  y  z  )  is  used  as  an  attitude  control  reference 

5  5  5 

by  the  autopilot  (Fig  5).  The  positive  axis  is  in  the  direction  of  the 

ballistic  vector.  Positive  x  and  positive  z  lie  in  a  vertical  plane  with 

5  5 

positive  x^  upwards,  y^  completes  the  right-handed  triad. 

The  ballistic  vector  is  defined  by  an  azimuth  angle  A  measured  in  the 

horizontal  plane  from  true  north  and  an  elevation  angle  E,  the  angle  above  the 

horizontal  plane,  measured  in  the  vertical  plane.  Then  the  attitude  of  the 

command  reference  (x  y  z  )  relative  to  the  stable  reference  (xvz)  is  a 

5  5  5  0  0  U 

consequence  of  the  following  ordered  Euler  angle  rotations: 


(1)  90°  about  y  (reorientation  of  axes) 

(2)  -A  about  x  (azimuth) 

(3)  E  about  y  (elevation) 
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I 


The  orthogonal  transformation  from  the  stable  reference  (x  y  z  )  to  the 

0  0  0 

command  reference  (x^^z^)  is: 


A 


05 


-CASE 

-SA 

cAcE 


-sAsE 

CA 

SAcE 


-C£ 

0 

-sE 


(6) 


I 


I 


I 


I 


I 


» 


I 
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ATTITUDE  OF  COMMAND  REFERENCE  (X_Y_Z  ) 

5  5  5 

RELATIVE  TO  AUTOPILOT  REFERENCE  (xv  z  ) 

4  4  4 


The  orthogonal  tranformation  (Fig  1)  describes  the  attitude  of  the 

45 

command  reference  (x  y  z  )  relative  to  the  autopilot  reference  (x  y  z  ).  A 

555  4  4  4  45 

is  computed  as  the  product  of  known  matrices: 


T  T  T  T 
A45  =  A05  A01  M12  A23  M34 


(7) 


A0i  and  a05  are  computed  as  indicated  by  Eq  (4)  and  (6).  is  computed 

as  a  function  of  \  as  indicated  by  Eq  (5).  The  parameter  X  is  a  constant  for 
a  particular  cell  and  will  be  provided  (or  some  equivalent  parameter)  by  the 
Launcher  Control  Unit  (LCU)  following  cell  selection. 


The  source  of  the  misalignment  transformations,  M^  and  M^,  is  presently 
not  known,  pending  results  of  current  studies  of  system  misalignment  errors. 
These  may  be  provided,  in  full  or  in  part,  by  the  LCU,  may  be  computed  in  the 
fire  control  computer  from  externally  provided  data,  or  may  be  produced  by 
some  external  subsystem  dedicated  to  misalignment  correction.  In  any  event, 
the  tranformations  will  be  provided  to  the  fire  control  computer  for  autopilot 
initialization . 


I 
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PREDICTED  ATTITUDE  OF  COMMAND  REFERENCE  ( x_y  z  ) 

5  5  5 

RELATIVE  TO  AUTOPILOT  REFERENCE  (x  v  z , ) 

4  4  4 

Let  the  vector  a  denote  the  angular  velocity  of  the  autopilot  reference 
(x^y^z^)  relative  to  the  stable  reference  (x^y^z^)  and  let  6  represent  the 
angular  velocity  of  the  command  reference  axes  (x^y^z^)  relative  to  the  stable 
reference  ( xQ  y^  z Q ) . 

The  time  derivative  of  the  orthogonal  transformation  A,,  is  given  by: 

45 


A45  =  A45fl 


(8) 


where  ft  is  the  skew-symmetric  matrix: 


0 

(ez4" 

°z4) 

(a  - 

y4 

0  A) 
y4 

Q  = 

(“.-0.) 
z4  z4 

0 

(0  .  - 
x4 

a  ) 
x4 

(B  .  -  o  „) 
y4  y4 

(ax4  ‘ 

Bx4> 

0 

m 

The  angular  velocity 

vector  a. 

in  the 

absence 

of  dynamic  flexure,  is 

(9) 


identical  to  the  ship's  angular  velocity  vector  u>,  which  can  be  computed  from 

•  •  • 

ship's  roll,  pitch,  and  yaw  rates  (4,  8,  4r  respectively).  Then,  assuming  no 
dynamic  flexure,  we  compute  a  in  ship  reference  (x^y^z^)  coordinates: 


«xi  =  -  *36  +  ♦ 


(10) 


yi 


4C8S4  +  0c4 


oz1  =  i|ic  8c  4  -  as  4 


The  angular  velocity  B  must  be  computed  from  the  dynamics  of  the  command 

reference  frame  (x  y  z  ).  Specifically,  the  azimuth  and  elevation  rates,  A 
.  5  5  5 

and  E,  respectively,  must  be  computed.  Then  B,  in  stable  reference  coordi¬ 
nates  (x^gZ^),  is: 


xO 

9y0 

Bz0 


-EsA 

EcA 

-A 


(11) 


2 


The  differential  equation  [Eq  (8)]  provides  the  basis  for  prediction  or 
update  of  the  transformation  If  we  wish  to  predict  from  time  t  to  t  +  T, 

we  can  expand  A  in  a  Taylor  series  and  use  the  first  two  terms  as  a  first 

45 

order  approximation: 


A45(t  +  T)  %A45(t>  -  TA45<t)  (12) 

Other,  more  sophisticated,  approximations  are  common  in  the  literature  and  can 
be  provided,  if  required. 
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LEAST  SQUARES  ORTHOGONALI Z ATION  OF  NONORTHOGONAL  MATRICES 

Because  of  numerical  errors  in  digital  computations  and  slightly  nonor- 
thogonal  reference  axes,  algorithms  for  the  matrix  equations  described  herein  * 

generally  produce  slightly  nonorthogonal  matrices.  The  nonorthogonality  can, 
in  some  instances,  produce  adverse  effects.  Thus  it  is  common  in  such  compu¬ 
tations  to  include  some  subroutine  to  orthogonalize  the  computed  transforma¬ 
tions.  A  first-order,  least-squares  algorithm  for  orthogonalization  is  de-  * 

scribed  below. 

Let  A  represent  a  computed  transformation  matrix  which  is  "near-ortho¬ 
gonal."  The  least  squares  algorithm:  * 

X  =  A  (ATA)~1/2  (13) 

provides  an  orthogonal  transformation  which  is  nearest  to  A  in  a  least  1 

squares  sense.  That  is,  the  algorithm  minimizes  the  error  measure  e: 

e  =  TR[(A-A)T(A-A)]  (14) 

> 

(where  TR  indicates  the  matrix  trace  function)  subject  to  the  constraint  that 
be  orthogonal: 

'XaT  -1=0  (15)  ' 

Equation  (13)  is  computationally  difficult  because  the  square  root  func¬ 
tion  requires  computation  of  eigenvalues.  In  practice,  a  first  order  approxi¬ 
mation  is  usually  sufficient: 

A  =  A  +  1/2  A  (I  -  ATA)  (16) 

Other,  more  sophisticated,  orthogonalization  algorithms  are  common  in  the 
literature. 
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VELOCITY  OF  THE  LAUNCH  POINT  REFERENCE 
RELATIVE  TO  THE  MOVING  AIR  MASS  (R) 


We  define  the  following  vectors  (see  Fig  6): 


(1)  v  =  ship's  inertial  velocity  measured  at  some  reference  point  A  in 
the  ship. 


(2)  u  =  inertial  velocity  of  the  autopilot  reference  point  (point  B) . 

(3)  r  =  displacement  vector  from  point  A  (ship's  velocity  reference)  to 
point  B  (autopilot  reference). 


(4)  <*>  =  angular  velocity  of  the  ship  relative  to  the  stable  reference 


(5)  w  =  inertial  wind  velocity. 


Since  we  have  assumed  that  the  stable  reference  (xoy0zo^  is  an  *nertial 
reference,  all  inertial  velocities  are  computed  relative  to  that  reference. 

Autopilot  initialization  requires  the  velocity  of  the  autopilot  reference 

(B)  relative  to  the  moving  air  mass  in  conmand  reference  coordinates  (x  y  z  ), 

_  5  5  5 

that  is,  the  vector  quantity  -  w^. 


The  vectors  v  (ship's  velocity)  and  w  (wind  velocity)  are  measurements  in 
stable  reference  coordinates  ( xo^oZ0  ^  Provided  to  the  fire  control  system. 

The  vector  r  is  provided  by  the  ICU  when  a  particular  cell  has  been  selected. 
We  assume  that  r  is  provided  in  ship  reference  coordinates  (x^y^z^. 

The  angular  velocity  vector  w  may  be  computed  in  ship  reference  coordi¬ 
nates  (x^^z^)  from  ship  roll,  pitch,  and  yaw  rates  by  means  of  Eq  (10): 


k>  „ 

xl 

=  -  *se  + 

♦ 

U>  < 

yi 

=  \|)C  0S  ^  + 

• 

e<=d> 

• 

“zl 

=  <|>cec$  - 

es«j> 

Then: 


> 


I 


ft 


ft 


u5  -  w5  =  v5  +  <«5  X  r5)  -  w5 


AQ5  [v5  -  w5  +  Aq1(w1  x  r 1 ) ] 


where  x  indicates  the  vector  cross  product. 


(18) 


> 


ft 


ft 


ft 
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PREDICTED  VELOCITY  OF  THE  LAUNCH  POINT  REFERENCE  RELATIVE 
TO  THE  MOVING  AIR  MASS  (R) 

A  simple  linear  extrapolation  algorithm  can  be  used  to  provide  a  first- 
order  estimate  of  launch  point  reference  velocity  in  the  moving  air  mass  at 
some  future  time . 


To  simplify  notation,  let: 


(19) 


Then,  a  first-order  estimate  of  x  at  time  t  +  T^ 
computed  values  of  x  at  times  t  and  t  -  T^ 


can  be  determined  from 


Other,  more  complex  nonlinear  extrapolation  algorithms  may  be  used,  if  this 
simple  linear  extrapolation  is  inadequate. 
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APPENDIX 


MODIFIED  EQUATIONS  FOR  OP  1700  DEFINITIONS  (R) 


OP  1700  (Standard  Fire  Control  Symbols)  defines  own-ship  yaw  motion  as 
positive  to  starboard,  roll  motion  as  positive  to  port,  and  positive  pitch  as 
bow-down  attitude.  Using  these  definitions.  Fig  A-1  illustrates  the  ship 
reference  frame  (x^y,^).  The  attitude  of  the  ship  reference  (x^y^z^)  rela¬ 
tive  to  the  stable  reference  (x^y^^)  is  a  consequence  of  the  following 
ordered  Euler  angle  rotations: 

(1)  180°  about  the  z-axis  (reorient  axes) 

(2)  ♦  about  the  z-axis  (yaw) 

(3)  0  about  the  y-axis  (pitch) 

(4)  4  about  the  x-axis  (roll) 

Then  the  orthogonal  transformation  from  the  stable  reference  (x  y  z  )  to  the 

O'*  0  0 

ship  reference  is : 


-C\|)Cfl 

—  S\|>C0 

— S0 

-c<(is0s4 

-S<|lS0S$ 

+c0s4 

+s4>  c4 

-cl»c4 

-c4>sOc4 

-s4>s0c$ 

+c0c4 

— s4»  s4 

+d»s4 

The  launcher  reference  frame  (x  y  z  )  and  ship  reference  frame  (x  y  z  )  are 

“  “  A  111 

assumed  to  be  nominally  aligned.  Thus  a  change  in  orientation  of  the  ship 

reference  (x^y  z  )  requires  a  corresponding  reorientation  of  the  launcher 

reference  (x  y  z  ).  Therefore  the  transformation  A  will  change,  since  the 
*  ^  ^  23 

launcher  reference  (x^y^^)  reor*-ente<*  without  a  corresponding  reorienta¬ 
tion  of  the  autopilot  alignment  reference  (x^y^z^)* 
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